/*
 *  $Id$
 */

/*
 * log2asc.c - convert compact CAN frame logfile to ASC logfile
 *
 * Copyright (c) 2002-2007 Volkswagen Group Electronic Research
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions, the following disclaimer and
 *    the referenced file 'COPYING'.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. Neither the name of Volkswagen nor the names of its contributors
 *    may be used to endorse or promote products derived from this software
 *    without specific prior written permission.
 *
 * Alternatively, provided that this notice is retained in full, this
 * software may be distributed under the terms of the GNU General
 * Public License ("GPL") version 2 as distributed in the 'COPYING'
 * file from the main directory of the linux kernel source.
 *
 * The provided data structures and external interfaces from this code
 * are not restricted to be used by modules with a GPL compatible license.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH
 * DAMAGE.
 *
 * Send feedback to <socketcan-users@lists.berlios.de>
 *
 */

#include <stdio.h>
#include <string.h>
#include <time.h>
#include <libgen.h>
#include <unistd.h>

#include <net/if.h>
#include <linux/can.h>

#include "lib.h"

extern int optind, opterr, optopt;

void print_usage(char *prg)
{
    fprintf(stderr, "Usage: %s [can-interfaces]\n", prg);
    fprintf(stderr, "Options: -I <infile>  (default stdin)\n");
    fprintf(stderr, "         -O <outfile> (default stdout)\n");
    fprintf(stderr, "         -4 (reduce decimal place to 4 digits)\n");
    fprintf(stderr, "         -n (set newline to cr/lf - default lf)\n");
}

int main(int argc, char **argv)
{
    char buf[100], device[100], ascframe[100], id[10];

    struct can_frame cf;
    static struct timeval tv, start_tv;
    FILE *infile = stdin;
    FILE *outfile = stdout;
    static int maxdev, devno, i, crlf, d4, opt;

    while ((opt = getopt(argc, argv, "I:O:4n")) != -1) {
	switch (opt) {
	case 'I':
	    infile = fopen(optarg, "r");
	    if (!infile) {
		perror("infile");
		return 1;
	    }
	    break;

	case 'O':
	    outfile = fopen(optarg, "w");
	    if (!outfile) {
		perror("outfile");
		return 1;
	    }
	    break;

	case 'n':
	    crlf = 1;
	    break;

	case '4':
	    d4 = 1;
	    break;

	default:
	    fprintf(stderr, "Unknown option %c\n", opt);
	    print_usage(basename(argv[0]));
	    return 1;
	    break;
	}
    }

    maxdev = argc - optind; /* find real number of CAN devices */

    if (!maxdev) {
	fprintf(stderr, "no CAN interfaces defined!\n");
	print_usage(basename(argv[0]));
	return 1;
    }
	
    //printf("Found %d CAN devices!\n", maxdev);

    while (fgets(buf, 99, infile)) {
	if (sscanf(buf, "(%ld.%ld) %s %s", &tv.tv_sec, &tv.tv_usec,
		   device, ascframe) != 4)
	    return 1;

	if (!start_tv.tv_sec) { /* print banner */
	    start_tv = tv;
	    fprintf(outfile, "date %s", ctime(&start_tv.tv_sec));
	    fprintf(outfile, "base hex  timestamps absolute%s",
		    (crlf)?"\r\n":"\n");
	    fprintf(outfile, "no internal events logged%s",
		    (crlf)?"\r\n":"\n");
	}

	for (i=0, devno=0; i<maxdev; i++) {
	    if (!strcmp(device, argv[optind+i])) {
		devno = i+1; /* start with channel '1' */
		break;
	    }
	}

	if (devno) { /* only convert for selected CAN devices */
	    if (parse_canframe(ascframe, &cf))
		return 1;

	    tv.tv_sec  = tv.tv_sec - start_tv.tv_sec;
	    tv.tv_usec = tv.tv_usec - start_tv.tv_usec;
	    if (tv.tv_usec < 0)
		tv.tv_sec--, tv.tv_usec += 1000000;
	    if (tv.tv_sec < 0)
		tv.tv_sec = tv.tv_usec = 0;

	    if (d4)
		fprintf(outfile, "%4ld.%04ld ", tv.tv_sec, tv.tv_usec/100);
	    else
		fprintf(outfile, "%4ld.%06ld ", tv.tv_sec, tv.tv_usec);

	    fprintf(outfile, "%-2d ", devno); /* channel number left aligned */

	    if (cf.can_id & CAN_ERR_FLAG)
		fprintf(outfile, "ErrorFrame");
	    else {
		sprintf(id, "%X%c", cf.can_id & CAN_EFF_MASK,
			(cf.can_id & CAN_EFF_FLAG)?'x':' ');
		fprintf(outfile, "%-15s Rx   ", id);
		
		if (cf.can_id & CAN_RTR_FLAG)
		    fprintf(outfile, "r"); /* RTR frame */
		else {
		    fprintf(outfile, "d %d", cf.can_dlc); /* data frame */
		    
		    for (i = 0; i < cf.can_dlc; i++) {
			fprintf(outfile, " %02X", cf.data[i]);
		    }
		}
	    }
	    if (crlf)
		fprintf(outfile, "\r");
	    fprintf(outfile, "\n");
	}
    }
    fflush(outfile);

    return 0;
}
